package com.dog.basics.common.util;

import cn.hutool.core.collection.CollUtil;
import org.gavaghan.geodesy.Ellipsoid;
import org.gavaghan.geodesy.GeodeticCalculator;
import org.gavaghan.geodesy.GeodeticCurve;
import org.gavaghan.geodesy.GlobalCoordinates;

import java.util.List;

/**
 * @zmr
 * @date2020/6/17 0017上午 9:33
 */
public class PositionUtil {

    /**
     * 通过经纬度计算距离
     *
     * @param lat1
     * @param lng1
     * @param lat2
     * @param lng2
     * @return
     */
    public  static double getDistance(Double lat1, Double lng1, Double lat2, Double lng2) {
        double EARTH_RADIUS = 63781380;
        // 经纬度（角度）转弧度。弧度用作参数，以调用Math.cos和Math.sin
        double radiansAX = Math.toRadians(lng1); // A经弧度
        double radiansAY = Math.toRadians(lat1); // A纬弧度
        double radiansBX = Math.toRadians(lng2); // B经弧度
        double radiansBY = Math.toRadians(lat2); // B纬弧度
        // 公式中“cosβ1cosβ2cos（α1-α2）+sinβ1sinβ2”的部分，得到∠AOB的cos值
        double cos = Math.cos(radiansAY) * Math.cos(radiansBY) * Math.cos(radiansAX - radiansBX)
                + Math.sin(radiansAY) * Math.sin(radiansBY);
//        System.out.println("cos = " + cos); // 值域[-1,1]
        double acos = Math.acos(cos); // 反余弦值
//        System.out.println("acos = " + acos); // 值域[0,π]
//        System.out.println("∠AOB = " + Math.toDegrees(acos)); // 球心角 值域[0,180]
        return EARTH_RADIUS * acos; // 最终结果
    }

    public  static  void  main(String[] args){
         System.out.println( getDistanceMeter(new GlobalCoordinates(34.795597,113.601405),new GlobalCoordinates(34.795827,113.602123),Ellipsoid.Sphere));
        //创建GeodeticCalculator，调用计算方法，传入坐标系、经纬度用于计算距离

    }
    public static double getDistanceMeter(GlobalCoordinates gpsFrom, GlobalCoordinates gpsTo, Ellipsoid ellipsoid) {

        //创建GeodeticCalculator，调用计算方法，传入坐标系、经纬度用于计算距离
        GeodeticCurve geoCurve = new GeodeticCalculator().calculateGeodeticCurve(ellipsoid, gpsFrom, gpsTo);

        return geoCurve.getEllipsoidalDistance();
    }

    /**
     * 计算一个点的圆的外界正方形
     * @param longitude
     * @param latitude
     * @param distance
     * @return
     */
    public static List<Double> findNeighPosition(double longitude, double latitude, double distance) {
        //先计算查询点的经纬度范围
        double r = 6371;//地球半径千米
        double dis = distance;//距离
        double dlng = 2 * Math.asin(Math.sin(dis / (2 * r)) / Math.cos(latitude * Math.PI / 180));
        dlng = dlng * 180 / Math.PI;//角度转为弧度
        double dlat = dis / r;
        dlat = dlat * 180 / Math.PI;
        double minlat = latitude - dlat;
        double maxlat = latitude + dlat;
        double minlng = longitude - dlng;
        double maxlng = longitude + dlng;

        return CollUtil.newArrayList(minlat, maxlat, minlng, maxlng);

    }
}
